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

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