Revert "Trimmed the branch to only the ompl sub directory"

This reverts commit 8a1b1870cdcb9c4be6ad8c6dd461f98b16dcd0e8.
Rebase from 'upstream'
Trimmed the branch to only the ompl sub directory