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

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