bug fix in FindEarliestProfileIntersection and ExtractOpenRAVETrajectoryFromProfiles