hector_exploration_planner: Publish original goal and observation poses for debugging