Add a way to call the enhanced navigation planning algorithms in FUNMAP

[hello-robot-shehab]

#201 added A* and RRT algorithms to FUNMAP's planning algorithms.

• There's currently no way to switch the planner, perhaps a ros param would be helpful.
• We also need documentation around these new algorithms.