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

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