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

This reverts commit ade37746c44d0f534c4fb7493e97e8e61f3628fd.
Rebase from 'upstream'
Trimmed the branch to only the planning_interface sub directory