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

This reverts commit 0094e814960751d531e277585e93875b50286de6.
Rebase from 'upstream'
Trimmed the branch to only the bwi_planning_common sub directory