[hector_exploration_planner]
* Use desired distance (check if selected pose reachable coming up next
[hector_exploration_planner]
* Decrease distance the desired distance would be in occupied space
[hector_exploration_planner]
* Fix wrong orientation for observation pose
tuned max elevation for final run