Added function to convert vector path to JointTrajectory. It should really also take in a vector of strings to be used as joint names.