[hector_exploration_planner] various further fixes, cleanup required