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

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