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

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