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

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