hector_exploration_planner: Fix inner exploration (would never be reached)