Initial addition of boost graph structures and creation.
Converted logs to wrapped log stream. Corrected formatting. Converted vector of cartesian trajectory points to boost pointer of base trajectory points. Moved trajectory linking vector to internal property.
Merge pull request #7 from ros-industrial-consortium/trajectory_planning_graph

Initial addition of boost graph structures and creation.