Merge remote-tracking branch 'upstream/hydro-devel' into upstream_hydro_devel
Corrected null init of uuid when constructing links
Added draft of add/modify/remove trajectories. Corrected int concatenation of linear edge weight in calculation.
Removed debug log
Refactoring edge weight calculation to remove redundancy
Merge branch 'hydro-devel' of https://github.com/ros-industrial-consortium/descartes into upstream_hydro_devel
Merging remote branch upstream/hydro-devel
Correcting issues in add/modify/remove. Null cartesian points were being inserted in the map and graph, causing discontinuities. Add and Modify have been tested in the latest UI and appear to be correct. There is still an issue in Remove.
Added const accessor for cartesian points from graph class
Debugging modify algorithm.
Corrcted issue in modify in removing old edges and vertices. Modified getCartesianMap function.
Corrected issue in vertex descriptors and iterators being unstable when using vecS as the underlying graph vertex structure.
Corrected issue in remove point. Changing logging down to ROS_DEBUG in places.
Cleaning up logs.
Merge pull request #36 from psturgeon/planning_graph_optimization

Planning graph optimization