Sync to ompl/ompl master

Merging the ompl/ompl master into the batch_informed_trees branch.