Move OMPL paths before catkin to avoid compilation against ROS OMPL package when specifying a different OMPL installation