moved trajectory lookup to moveit_core