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

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