Converted shortest path calculation to use boost::UUID. Initial (incomplete) version of addTrajectoryPt.