Initial addition of boost graph structures and creation.

In all failure cases, we should log an appropriate error.  See [here](https://github.com/ros-industrial-consortium/descartes/blob/hydro-devel/descartes_trajectory_planning/src/joint_trajectory_pt.cpp#L96) for a logging example.