[hector_exploration_planner]
* Various bugfixes