added basic cost function selection capability to the ompl interface for moveit